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PREFACE 


This  Is  the  final  report  for  the  U.S.  Army  Contract  DAAK10-78-C-0325 
on  the  applications  of  time  delays  and  microprocessors  in  control 
system  design. 
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1.  STMT.  VARIABLE  RECONSTRUCTION  USING  TIME  DELAYS 


1.1  INTRODUCTION 


One  of  the  problems  which  occur  occasionally  in  designing  a  satis¬ 
factory  controller  for  a  deterministic  control  system  is  the  need  of  the 
state  variables  which  are  not  directly  measurable.  Luenberger  proposed 
a  scheme  which  approximately  reconstructs  inaccessible  variables,  (see 
'ref.  [1]  and  [ZD.^No  methods,  however,  are  currently  available  for 
exactly  reconstructing  the  missing  variables  from  observable  variables. 
In  this  paper  a  method  is  presented  for  exactly  reconstructing  the 
inaccessible  variables.  It  uses  measurable  variables,  their  delayed 
values  and  the  control  variables  on  the  maximum  delay  interval.  As 
can  be  seen  in  Examples,  the  method  may  give  satisfactory  results  in 
certain  cases  and  can  be  easily  implemented  using  a  microprocessor. 

For  the  sake  of  simplicity  only  time  invariant  linear  control 
systems  are  considered.  The  extension  to  time  varying  linear  systems 
is  straight-forward.  The  use  of  delayed  state  variables  was  first  pro¬ 
posed  by.  Gilchrist  in  ref.  (3],  where  a  similar  problem,  but  from  a  some 
what  different  point  of  view,  was  investigated.  Preliminary  results  of 
the  method  proposed  in  the  paper  were  reported  in  ref.  [4). 
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1.2  PROBLEM 


Consider  the  linear  time  invariant  control  system 

x(t)  -  Ax(t)  +  Bu(t)  (1) 

where  x  is  the  n  x  1  state  vector,  u  is  the  r  x  1  control  vector,  A  is 
an  n  x  n  constant  matrix,  and  B  is  an  n  x  r  constant  matrix.  Suppose 
the  observable  vector,  that  is,  the  variables  which  can  actually  be 
measured,  y(t)  is  given  by 

y(t)  -  Hx(t)  (2) 

where  y  is  an  m  x  1  vector,  and  H  is  a  non-zero  m  x  n  constant  matrix. 
'Let  0  <  h^  <  h^  <  •••  <  h^  <  «  be  time  delays. 

The  problem  is  to  reconstruct  the  state  variable  vector  x(t)  from 
the  measurable  vectors  y(t  -  h^) ,  y(t  -  hj) ,  ....  y(t  -  h^)  and  the 
measurable  control  vector  u(s) ,  t  -  h^  <  s  <  t. 
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1.3  RESULTS 


The  response  x(t)  of  the  system  (1)  is  given  by 


x(t)  -  e' 


A(t  -  (t  -  h 


i^x(t  -  h  )  +  f  eA(t  '  s)Bu(s)ds 
1  ;t-h. 


Ahi  /■' 

a  x(t  -  h±)  +J 


e  AsBu(t  +  s)ds,  i  =  1,2 


-Ah 

Nultiplying  He  on  both  sides. 


-Ah 

He  Ax(t)  -  Hx(t  -  hi)  +  He 


e  AsBu(t  +  s)ds 


-  Ah  r  c 

y(t  -  h±)  +  He  1  J 


e  AsBu(t  +  s)ds. 


(3) 


Since  y(t  -  h^),  i  =  1,2,...,£,  and  u(s) ,  t  -  h^  <  s  <  t,are  measurable, 

the  right  hand  side  of  eq.  (3)  is  known  for  each  i,  and  so  eq.  (3)  is 

simply  linear  simultaneous  algebraic  equations  for  n  unknowns 

x(t)  -  (x.(t),  x,(t),  ....  x  (t)).  Let 
x  x  n 


-Ah, 


He 


-Ah„ 


He 


-Ah. 


He 


and  lee 


z(t) 


y(t  -  h.)  +  He 


-Ah.  r  o 

e  *  SBu(t  +  s)ds 


f 


y(t  -  h2)  +  He 


-Ah.  /•  o 

1  e  Bu(t  +  s)ds 


-'-K 


—Ah.  r  o 

y(t  -  h^)  +  He  I  e  sBu(t  +  s)ds 

~hl 


Eq.  (3)  can  now  be  rewritten  as 


Cx(t)  -  z(t)  .  (4) 

Obviously  C  is  a  known  mi  x  n  constant  matrix  and  z(t)  is  a  known  mi  x  1 
vector  for  each  t.  If  the  rank  of  the  matrix  C  is  a,  then  x(t)  is  given  by 

*(t)  •'[CTC]'1CTz(t),  (5) 

Result  1  If  rank  (C)  ■  n,  then  x(t)  »  [CTC]  *CTz(t). 

Note  that  since  C  is  a  constant  matrix,  if  the  state  x(t)  can  be  recon¬ 
structed  at  some  t,  then  it  can  be  reconstructed  for  all  t.  However,  the 
rank  of  the  matrix  C  is  dependent  on  the  delays  1^,  h^,  •••,  h^,  and  so 
the  question  is  now  whether  there  exists  a  set  of  delays  h^,  h^,  h^ 

such  that  the  corresponding  matrix  C  has  rank  n  for  a  given  system,  that  is, 
for  the  given  matrices  A,  B  and  H.  Let  Q  be  the  nit  sn  matrix  defined  by 
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The  argument  used  in  the  proof  of  the  following  lemma  and  also  in 
the  proof  the  next  result  is  similar  to  chat  of  ref.  [5]  (pp.  81-82). 


Lemma  1  Let  I  be  a  non-zero  interval.  If  rank  (Q)  *  n,  then  the 

* 

vector  space  spanned  by  the  n  x  1  row  vectors  of  the  matrices  He  for 
all  h  in  1  is  Rn,  that  is,  the  row  vectors  contain  n  independent  vectors 

Proof  Suppose  the  contrary.  Then  there  exists  a  nonzero  1  x  n 

vector  b  such  that 

He_Ah  b  =  0 


on  I.  By  repeated  differentiation  with  respect  to  h, 

u  “Ah  .  a, .  Ah  »  >  n— 1  —Ah  > 

He  b  ■  HAe  b  -  ..."  HA  e  b  ■  0 


on  I,  and  so 

rank  (Q)  *  rank 


HA 


<  n. 


This  is  a  contradiction,  and  hence  the  lemma  is  true. 


Result  2  There  exists  a  set  of  n  delays  0  <  h.  <  h-  •••  <  h  <a 
-  .  -  1  2  n  - 

for  any  given  a  >  0  such  that  the  rank  of  the  corresponding  matrix  C 
is  n  if  and  only  if  rank  (Q)  *  n. 

Proo£  Consider  the  necessary  condition  first.  Suppose  rank  (C) 

and  assume  rank  (Q)  <  n.  Then  there  exists  a  non-zero  n  x  1  vector  b 

such  that 


Hb  -  HAb  «  ...  HAn_1  b  -  0. 


This  implies 


He-Ah  b  -  0 


for  all  h,  and  hence  rank  (C)  <  n.  This  is  a  contradiction,  and  thus 
rank  (Q)  *  n. 

Now  consider  the  sufficiency.  If  there  exist  n  delays 


0<h1<h_«»»<h  <a 
-  1  2  n  - 


such  that  the  matrix 


-Ah, 


He 


-Ah 


He 


2  I 


-Abn  , 

H.  j 
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,  contains  n  independent  row  vectors,  then  the  sufficiency  is  proved. 

Let  I  be  the  non-zero  interval  [0,  a].  Then  by  Lemma  1,  the  matrices 
He  hel,  contain  n  independent  n  x  1  row  vectors.  This  implies  that 
there  exists  a  set  of  delays  |  h^,  h^,  ••*,  h^  }  in  I  such  that  the  matrix 
C, 


contains  n  independent  n  x  1  row  vectors.  Thus,  if  rank  (Q)  *  n  then 
there  exists  at  least  one  set  of  n  delays  0  <  h^  <  h2  <  •••  <  hQ  <  a, 
such  that  rank  (C)  *  n.  This  completes  the  proof. 

Since  a  is  any  given  positive  constant  in  the  above  result,  the 
n  delays  {  h^j  may  be  chosen  arbitrarily  small,  and,  in  fact,  almost  any 
n  different  delay  values  may  be  used.  However,  as  can  be  seen  in 
Example  1,  this  does  not  necessarily  mean  that  any  n  different  values 
can  be  used.  In  other  words,  there  are  delay  values  which  may 

not  be  used.  Furthermore,  because  of  certain  technical  reasons,  not 
only  the  Inappropriate  delay  values  but  also  the  delay  values  near  them 
should  be  avoided.  It  is  usually  convenient  to  choose  *  0. 

In  almost  all  of  the  control  systems,  certain  state  variables  are 
usually  directly  measurable,  that  is,  some  components, say,  y^,  y^,  y^, 

of  the  observation  vector  y  are  the  same  as  the  corresponding  components 


7 


of  the  state  variable  x.  In  this  case,  by  choosing  tu  a  0,  the  first 

matrix  element  of  the  matrix  C  contains  at  least  2  ^dependent  row 

vectors,  and  hence  at  most  n  -  2  additional  independent  vectors  are 

-Ahx 

needed  for  rank  (C)  *  n.  This  means  that,  besides  the  matrix  He  *  H 

-Ahi 

in  the  matrix  C,  at  most  n  -  2  matrices  He  are  required  for  rank  (C) 
The  following  lemma  summarizes  the  result. 

Lemma  2  If  rank  (Q)  *  n,  and  2  components  of  the  observed  vector  y 

are  identical  with  the  corresponding  components  of  the  state  variable  x, 
then,  in  addition  to  h^  *  0,  at  most  n  -  2  additional  delays  are  required 
for  state  reconstruction. 

1.4  EXAMPLES 

Example  1  Consider  the  linear  scalar  system 
v"  +  2v'  +  2v  =  u  9 

and  suppose  the  only  quantity  measurable  is 

w  -  v  +  v' . 


We  wish  to  reconstruct  the  original  state  variables.  Let 


7  ■  v  +  v'  ■  x^  +  X2« 
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.  Then 


y  -  (1,  l)x. 

The  matrix  Q  is  given  by 


q  - 

h" 

' 

1  0 

HA 

l 

i 

o 

_ 1 

and  rank  (Q)  »  2.  Hence  the  state  variable  x  can  be  reconstructed.  Choose 
h^  »  0,  h2  *  h.  Then 


-Ah  h 
e  »  e 


cos(h)  -  sin(h)  -sin(h) 


2  sin(h) 


cos(h)  +  sin(h) 


and 


—  — 

H 

m 

l 

1 

u  "Ah 
He 

e^(cos(h)  4*  sin(h)) 

e^cos(h) 

_  _ 

— 

_ 

Now,  rank(C)*  2  if  sin(h)  t  0,  Chat  is,  h  /  £tt,  i  =  1,2,**«.  Note  that, 
although  almost  any  value  may  be  chosen  for  the  delay  h  to  reconstruct 
the  state  variable,  there  are  particular  numbers,  namely,  h  ■  lir,  which 
cannot  be  used.  Let  h  i  iir,  l  »  1,2,***.  Then 
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and 


z(t) 


y(t) 


r 

J  -h 


y(t  -  h)  +  He  ^  f  e  ^sBu(t  +  s)ds 


y(t) 


y(t  -  h)  +  e  cos(h)  |  es[cos(s)  +  sin(s)]  u(t  +  s)  ds 

-h 

-  etlIcos(h)  +  sin(h)]  J"  eSsin(s)  u(t+s)  ds 


x(t)  -  C-1z(t).  Thus 


‘lCt)  'iRio  [*(e ' 


h  r° 

x*  It )  » — I  vCt  -  h)  +  e  cos(h)  /  eS[cos(s)  +  sin(s)]u(t  +  s)ds 

J  -h 


-  e  [cos(h)  +  sin(h) ] J"  eSsin(s)u(t  +  s)ds  -  cos(h)y(t)^ 
><t)  "  sin(h)  [tcos(h)  +  sin(h) ]y(t)  -  y(t  -  h) 


-  e^cos(h)  eS[cos(s)  +  sin(s)]  u(t+s)  ds 

J-h 


+  e*1[cos(h)  +  sin(h)]  f  essin(s)u(t  +  s)ds 
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(i)  Step  Input 


(ii)  Sinusoidal  Input 


Pig.  2  Responses  of  v"+2v'+2v  -  u  (Time:  5  m/sec.). 


The  system  was  simulated  on  an  analog  computer  and  the  reconstruction 
was  carried  out  on  a  microprocessor  as  shown  in  Fig.  1.  The  delay  value 
used  was  h  =  0.05  sec.,  the  accuracy  of  the  A/D  and  D/A  converters  was 
8  binary  hits,  the  sampling  interval  was  500u  sec.,  and  the  microprocessor 
u°  'd  was  MOS  6502.  The  result  for  x^(t)  is  given  in  Fig.  2. 

Eximple  2  To  study  the  effectiveness  of  the  proposed  method  in  a  real 
world  environment,  a  d.c.  motor  speed  regulator  was  investigated.  It  was 
a  Motomatic  Control  Systems  Laboratory  experiment  kit  made  by  Electrocraft, 
and  was  consisted  of  an  operational  amplifier,  a  power  amplifier  and  a  d.c. 
motor  -  tachometer  unit.  Only  the  speed  of  the  motor  was  measurable  through 
the  tachometer,  and  the  acceleration  variable  was  inaccessible.  On  the 
other  hand,  the  acceleration  variable  was  needed  for  a  satisfactory  con¬ 
troller  design,  and  the  main  problem,  therefore,  was  to  reconstruct  the 
acceleration  variable  from  speed  variable  and  the  control  variable.  In 
addition, we  were  also  Interested  In  the  effect  of  measurement  noise,  the 
sensitivity  of  the  proposed  method  with  respect  to  system  parameters  and 
the  real-time  implementation.  No  particular  effort  was  made  to  clean  up 
the  noisy  measurement  of  the  speed,  and  the  system  was  modeled  as  a  second 
order  linear  system.  The  real  system,  however,  contained  considerable  non¬ 
linear  friction. 

The  system  diagram  is  given  in  Fig.  3.  The  open- loop  transfer  function 
ia  approximately  G  =  90/s(s  +  1.31).  The  corresponding  differential  equation 
is 


V"  +  1.31v'  -  90u 


where  v  is  the  speed  and  u  is  the  control  function.  When  only  the  available 
•peed  variable  was  used  in  the  controller,  that  is, 
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mUtm 


m 


(b)  With  reconstructed  acceleration  feedback 


Fig.  4  Step  Reference  Input  Response 


U  ■  V  r  -  V 

ref 

the  system  response  to  a  step  reference  input  was  as  shown  in  Fig.  4(a). 
Although  the  performance  could  have  been  improved  somewhat  using  classical 
compensation  network,  it  was  not  our  objective,  and  the  subject  was  not 
pursued  any  further.  Instead,  the  missing  acceleration  variable  v'  was 
reconstructed,  and  a  new  controller 

*  vref  ‘  v  "  0*13v' 

was  implemented.  The  system  response  to  the  same  step  reference  input 
for  the  new  controller  is  given  in  Fig.  4(b).  As  can  be  seen,  the 
response  was  quite  satisfactory.  The  small  ripples  in  the  response 
were  caused  by  the  tachometer  noise. 

To  reconstruct  the  acceleration  variable,  write  the  system  equation 
in  vector  form 


Let  h^  *  0  and  hj  “  h  >  0.  Then  simple  calculation  gives 
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and 


C  - 


0 


1.31 


t ,  1.31h, 

(1  -  e  ) 


Since  rank  (Q)  ■  2,  the  state  variables  can  be  reconstructed.  Further¬ 
more,  rank  (C)  ■  2  for  all  h  >  0.  Therefore,  for  any  delay  time  h  >  0, 
▼'(t)  can  be  reconstructed  and  is  given  by 


v'Ct) 


1.31 


,  1.31h  .. 

(e  -  1) 


[v(t)  -  v ( t  -  h)] 


90 


(e1-31  h  -  1) 


31(h+s) 


-  1)  u(t+s)  ds 


In  this  particular  example,  the  delay  was  h  =  0.04  sec.,  the  accuracy  of 
A/D  and  D/A  converters  was  10  binary  bits,  and  the  sampling  interval  was 
200p  sec. 
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1.5  CONCLUSIONS 


A  method  is  developed  for  exactly  reconstructing  inaccessible 
v r>riabler  in  a  linear  system  from  the  measurable  variables,  their 
».  !t-5  del' ved  values  and  the  control  variables  on  the  maximum  delay 
duration.  Examples  show  that  the  method  may  give  satisfactory  results 
in  certain  cases. 
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2.  DELAYED  FEEDBACK  CONTROLLER  FOR  A  DC  MOTOR  CONTROL  SYSTEM 


2.1  INTRODUCTION 

In  this  section,  a  new  controller  design,  which  uses  only  the  observed 
state  variables,  is  investigaed.  It  is  based  on  time  delayed  state 
variable  feedback  can  be  easily  implemented  by  a  microprocessor.  The 
method  has  been  applied  to  several  laboratory  systems  and  is  found  to 
be  almost  as  effective  as  an  optimal  controller. 

2.2  PROBLEM  STATEMENT 

Consider  a  linear  time  invariant  control  system  which  is  given  by  the 
vector  differential  equation 

x(t)  -  a  x ( t )  +  B  u(t)  ,  x(0)  -  xQ 
y(t)  -  C  x(t) 

where  x  is  the  n-dimensional  state  vector,  u  is  the  r-dimensional  control 
vector,  and  y  is  the  m-dimensional  observed  vector.  A,  B  and  C  are  constant 
matrices  with  compatible  dimensions.  Let  J(u)  be  a  cost  functional  defined 
by 

J(u)  “  [  f (x(t) ,u(t))dt  . 

'0 

The  problem  is  to  find  a  feedback  controller  u  in  the  form  of 
N 

u  '  I  K.  y(t  -  h  ) 
j-o  J  J 

which  minimizes  the  cost  functional  J(u)  oyer  all  delayed  feedback 
controllers.  Here,  O-hg^hjCl^  ...  C  h^  are  time  delays  and  K  ^ , 
j=*0,  J,  2,  ...,N,  arc  sxnlar  constants. 
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The  firsc  question  is  whether  there  exists  an  optimal  controller  which 
minimizes  the  cost  functional.  If  such  a  control  exists,  then  the  next 
question  is  how  to  determine  the  number  of  delays  N,  the  delays  h.  and 
the  delay  coefficients  K.  .  At  present,  no  answers  are  available  to  the 
above  questions.  A  preliminary  study  indicates  that  the  minimum  number 
of  delays  N  should  be  at  least  equal  to  n  -  s,  where  s  is  the  number 
of  linearly  independent  variables  in  y.  In  the  current  investigation, 
the  delayed  feedback  controller  is  derived  in  the  following  way.  First, 
the  number  of  delays  is  chosen  to  be  equal  to  n-s.  Then  the  delays  h^ 
are  chosen  to  be  large  enough  so  that  the  absolute  value  of  y(h^)  -  y(h^) 
is  substantially  larger  than  the  measurement  noise  during  transient. 

Then  the  constants  are  chosen  by  numerical  iteration.  Let  K  be  the 
vector  (Kq,  K^,  ...  ,  K^) .  Once  N  and  h.  are  determined,  u  is  uniquely 
determined  by  K.  Let  u  *  u(K) ,  and  K*  be  the  optimal  parameter  set. 

Then,  assuming  the  iteration  converges,  K*  may  be  determined  by  the 
iteration 

Ki+1  "  Ki  “  A -grad  J(Ki). 


2.3  EXPERIMENTAL  RESULTS 

« 

In  order  to  study  the  feasibility  of  the  proposed  method,  a  third  order 
d.c.  motor  driven  position  control  system  as  shown  in  Fig.l  was  investigated. 


(W  SASIC  MATHEMATICAL  MODEL 

Fig.  1.  Third  order  d.r.  rotor  position  tontiol  s-.cw-i. 


There  are  basically  two  reasons  for  adding  the  integrator.  The  first 
is  to  construct  a  third  order  system,  and  the  second  is  to  minimize 
the  steady  state  position  error  due  to  the  nonlinear  Coulomb  friction 
in  the  system  and  also  to  eliminate  the  staedy  state  tracking  error, 
that  is,  the  steady  state  position  error  when  the  reference  input  is 
a  ramp  function.  The  control  function  u  is  the  input  voltage  to  the 
Integrator,  and  the  output  9  is  the  motor  shaft  position  measured  by 
a  potentiometer. 

To  establish  a  baseline  performance  criterion  and  also  for  the  purpose 
of  comparison,  a  conventional,  feedback  control  using  both  the  position 
and  velocity  variables  was  investigated  first.  The  velocity  was 
measured  by  a  tachometer.  The  system  is  shown  in  Fig. 2  below. 


71g.  2.  Conventional  feedback  control. 


The  tachometer  feedback  gain  K  was  determined  experimentally  so  that 
the  system  settling  time  for  a  step  reference  input  was  minimized. 

It  was  found  that  the  settling  time  was  minimum  when  K  *  0.77,  and 
the  corresponding  response  was  as  shown  in  Fig. 3 


Fig.  3.  Step  input  response  of  conventional 
feedback,  controller  (2^  tmn/sec.). 


The  settling  time  was  about  1  see.,  and  there  was  a  sustained  small 
oscillation  during  the  transient.  Although  the  system  performance 
night  have  been  improved  by  adding  compensation  network,  this  possi¬ 
bility  was  not  pursued  any  further. 

The  delayed  state  variable  feedback  controller  was  investigated 
next.  It  was  assumend  that  only  the  shaft  position  was  measurable, 
eliminating  the  need  for  measuring  the  velocity  of  the  shaft  of  the 
motor.  The  mathematical  model  of  the  system  is  now  given  by 

•  +  11.4  8’*  -  31800  U 

y  ■  e  . 

Because  the  system  dimension  is  3,  and  the  observed  vector  y  is  of 
dimension  1,  two  time  delays  h^  and  h^  were  used  in  the  controller. 
The  values  were  chosen  to  be  h^»4.65  msec,  and  h2“9.30  msec.  The 
controller  is  given  by 

u  -  8refCt)  -  (  Kx  0(t)  +  K2  8(t-0. 00465)  +  K3  eC.t-0.0093)  ) 
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Here,  0  ^  is  the  reference  input.  The  main  objective  is  to  force  the 

output  0(t)  to  be  the  same  as  the  reference  input  9ref(t)»  that  is, 
0(t)  »  ®ref^C^'  ^  block  diagram  of  the  system  is  shown  in  Fig. 4  below. 


CONTROLLER 

Fig.  4.  Delayed  variable  feedback  controller. 

The  cost  functional  J(u)  is  given  by 
j(u)  -  J*  Uetaf  -  e(t))2  +  u(t)2}  dt 

where  0  ^  is  the  unit  step  function  and  the  system  is  at  rest  at  t*0, 
that  is,  0(0)  ~0’(O)  *  9"(0)  =  0.  The  values  K^,  Kj  and  were 
determined  by  the  iteration  method  mentioned  above,  and  the  values 
were  found  to  be  K^=»113,  ^=-203  and  K^*91.  The  upper  limit  of  the 
Integral  for  the  cost  functional  was  chosen  to  be  2  sec.  mainly  because 
the  conventional  feedback  control  system  reached  its  final  value  for 
a  step  function  input  in  about  1  sec . ,  which  is  much  shorter  than  the 
upper  limit  of  2  sec. 

When  the  optimal  delayed  state  variable  feedback  controller  was 
implemented,  the  step  reference  input  response  was  as  shown  in  Fig. 5. 
The  settling  time  was  less  than  0.4  sec.,  and  the  transient  response 
was  very  smooth. 


0 1  1.0  2.0 
t (sec) 


Fig. 5  Step  Input  Response  of  Delyaed  Feedback  System. . 

2.4  CONCLUSIONS 

It  was  shown  experimentally  that  the  delayed  state  variable  feedback 
controller  is  an  effective  controller.  Even  though  it  used  only  the 
position  variable,  the  response  was  at  least  five  times  faster  than 
the  conventional  controller.  Furthermore,  the  transient  response  of 
the  delayed  feedback  controller  was  much  smoother  than  the  corresponding 
response  of  the  conventional  controller.  The  delayed  controller,  however, 
was  synthesized  more  or  less  experimentally,  and  further  studies  are 
needed  for  developing  analytic  methods  for  synthesizing  delayed 
feedback  controllers. 


3.  MICROPROCESSOR  BASED  IMPLEMENTATION  OF  DELAYED  FEEDBACK  CONTROLLERS 


I  INTRODUCTION 

1  this  paper,  a  microprocessor  based  digital  controller  £or  a  basically  third  order  d.c. 
>tor  driven  position  control  system  is  presented.  The  controller  uses  only  the  output 
isition  information,  which  is  measured  directly  using  a  digital  absolute  shaft  encoder. 

ie  result  is  compared  with  a  conventional  feedback  controller  using  both  the  position  and 
ilocity  variables.  It  is  shown  that  the  digital  controller  gives  very  satisfactory  per- 
jrmance. 

2  BASIC  SYSTEM 

ie  system  under  study  is  basically  a  third Prefer  d.c.  motor  driven  position  control 
stem  as  shown  in  Fig.  1.  Although  the  system  is  modeled  as  a  linear  system,  there  is  a 
ibstantial  nonlinear  Coulomb  friction.  In  fact,  there  is  a  substantial  steady  state 
’Sltlon  error  when  the  loop  is  closed  without  the  integrator. 


(b)  BASIC  MAT  HE M  AT ! C Al.  MOCEL 


Pig.  1.  Third  order  d.c.  motor  position  control  system 


? 


The  function  u(t)  Is  the  input  voltage  to  the  operational  amplifier,  and  the  output  8(t)  is 
the  shaft  position.  The  main  purpose  is  to  design  and  implement  a  controller  so  that  the 
output  0(t)  is  the  same  as  the  input  reference  function  9ref(c)* 

The  controller  investigated  is  basically  a  closed  loop,  or  feedback,  digital  controller, 
which  is  based  on  a  microprocessor  as  shown  in  Fig.  2.  It  should  be  noted  that,  although 
it  is  basically  a  third  order  system,  only  the  position  variable  6(t)  is  used  in  the 
design,  eliminating  the  need  for  a  tachometer,  an  additional  system  hardware. 


Fig.  2.  Digital  Controller 


3.3  CONVENS IONAL  CONTROLLER 

To  establish  a  baseline  performance  criterion  and  also  for  the  purpose  of  comparison,  a 
conventional  feedback  control  using  both  the  position  and  velocity  variables  is  Investigated 
first.  The  velocity  is  measured  by  a  tachometer.  The  system  is  shown  in  Fig.  3. 
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Fig.  3.  Conventional  feedback  control 
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The  tachometer  feedback  gain  K  is  determined  experimentally  so  that  the  system  settling 
time  for  a  step  reference  input  is  minimized.  It  is  found  that  the  settling  time  is 
minimum  when  K  -  0.77,  and  the  corresponding  response  is  as  shown  in  Fig.  4. 


t (25  div/sec) 


Fig.  4.  Step  input  response  of  conventional  feedback  controller 

he  settling  time  is  about  1  sec. ,  and  there  is  a  sustained  small  oscillation  during  the 
ransient.  Although  the  system  performance  could  be  improved  by  adding  compensation  net¬ 
work,  this  possibility  is  not  pursued  any  further. 

3.4  DIGITAL  CONTROLLER 

he  system  given  in  Fig.  1  can  be  represented  by  the  differential  equation 
0"'  +  11.40"  -  318 OOu  . 

•et  yx  -  0,  y2  -  0,  y3  -  0  and 

y  -  ryx 

y2 

y3. 

hen  the  system  equation  can  now  be  written  as  the  vector  differential  equation 


To  design  a  digital  controller,  it  is  first  necessary  to  discretize  the  above  equation. 
L*t  x(k)  -  y(kT),  and  v(k)  ■  u(t),  kT  <  t  <  (k+l)T,  where  T  is  the  sampling  interval. 


.'hen 


x(k+l)  -  Ax(k)  +  Bv(k) 


.here 
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:he  task  is  to  find  an  algorithm  for  v(k)  using  x^(k)  and  9re£  only  so  that  x^(k)  “  ®ref 
.n  steady  state.  Since  it  is  found  that  such  a  feedback  controller  is  not  unique,  further 
restrictions  are  Imposed  on  the  controller  v(k).  The  constraints  are  that  the  response 
jettling  time  is  minimized  and  the  output  0(t)  is  smooth  during  the  transient  for  a  step 
reference  input  0re£* 

3y  applying  a  recently  developed  method  for  synthesizing  an  optimal  controller  based  on 
ielayed  feedback  [1],  the  digital  controller  algorithm 

v(k)  -  0.5  8  £  -  80.5  x(k)  +  150  x(k-4)  -  70  x(k-8) 


is  obtained  for  the  sampling  interval  of  T  ■  1  msec.  The  actual  implementation  of  the 
rontroller  is  shown  in  Fig.  5. 
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Fig.  5.  Microprocessor  based  digital  controller  (T  *  1  msec.) 

averal  microprocessors  have  been  used  for  implementing  the  digital  controller.  In  all 
ases,  a  real  time  clock  of  1  msec  is  used  for  initiating  the  interrupt  driven  control 
lgorlthm.  The  accuracy  of  the  shaft  encoder  and  the  D/A  converter  is  12-bit.  When  an 
5L-11  microprocessor  Is  used,  132  16-bit  words  of  memory  are  required.  Other  micro- 
rocessors  investigated  are  MOS6502  (8-bit)  and  Motorola  XM68000  (16-bit). 

he  step  input  response  of  the  digital  controller  is  given  in  Fig.  6.  The  particular 
icroprocessor  used  for  the  experiment  is  LSI- 11. 


t(25  div/sec) 


Fig.  6.  Step  input  response  of  the  digital  controller 

Although  only  the  position  variable  is  used  in  the  digital  controller,  it  gives  s  much 
^stter  system  response  than  the  conventional  feedback  controller.  The  settling  time  for 


a  step  reference  Input  is  now  less  than  0.36  sec.,  which  is  about  3  times  faster  than  the 
conventional  controller.  Furthermore,  the  transient  response  of  the  digital  controller 
is  very  smooth. 

3.5  CONCLUSIONS  j 

A  microprocessor  based  digital  controller  is  designed  for  a  third  order  position  control 
system,  and  is  implemented  in  an  actual  system.  Although  it  uses  only  the  position  vari¬ 
able  it  is  shown  that  the  system  performance  is  very  satisfactory. 

3.6  REFERENCE  j 

1.  Chyung,  D.H.,  "On  a  New  Closed  Loop  Controller  Design" ,  1980  Conference  on  Information 
Sciences  and  Systems,  Princeton  University,  March  1980. 
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4.  DELAYED  FEEDBACK  CONTROLLER  FOR  AN  A.C.  MOTOR  CONTROL  SYSTEM 


Input 


The  system  considered  is  an  a.c.  motor  driven  third  order  position 
control  system.  A  block  diagram  is  shown  in  Fig.l  below. 


Fig.l  A.C.  motor  driven  position  control  system. 


The  output  variable  is  measured  by  a  digital  shaft  encoder.  Since  it 
Is  the  only  sensor  employed  in  the  system,  only  the  position  variable  is 
available  for  feedback,  that  is,  the  feedback  compensation  may  not  use 
velocity  and  acceleration  variables. 

The  mathematical  model  of  the  system,  which  is  determined  experimentally, 
la  given  by  the  following  transfer  function. 
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Fig. 2  Mathematical  model 


The  problem  Is  to  design  a  feedback  compensation  H(s) ,  using  only 
the  output  position  variable  xy  such  that  the  resulting  system  is  stable 
and  follows  the  reference  input  xref  Fig* 3  below  shows  the  closed  loop 
control  system. 


Fig*  3  Closed  loop  system. 


The  major  difficulty  in  designing  a  satisfactory  compensation  H(s)  is 

that  the  system  is  a  third  order  system  and  the  acceleration  and  velocity 

variables  are  not  available  for  feedback.  That  is,  H(s)  may  not  contain  s 
2 

and  a  terms . 

To  resolve  the  difficulty,  consider  the  time  delayed  feedback  compensation, 
H(s)-  +  K2e~TlS  +  K2e~T2S  . 

The  feedback  now  contains  only  the  output  variable  x.  However,  the  feedback 
loop  also  contains  two  time  delayed  values  x(t-T^)  and  xCt-Tj).  A  block 
diagram  of  the  system  is  given  in  Fig.  4. 


ref  -Q 


v  .  v  -T.s  -T,s 

119 

X 

s2(s-1.6) 

Fig. 4  Delayed  feedback  system. 


In  the  current  system,  the  time  delays  T^  and  Tj  are  chosen  to  be  0.015  sec 
and  0.03  sec.,  respectively.  To  satisfy  the  requirement  x-xre£  in  steady  state, 
the  feedback  parameters  must  satisfy  the  condition 


+  K2  +  K3  -  1. 
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The  task  is  now  to  find  the  feedback  constants  K^,  K,.,  and  K^.  The  Bode 
plot  of  the  forward  loop  transfer  function  G(s)  is  designated  by  G  in  Fig. 5. 
For  Kj“473,  K2*-916  and  K^*443,  the  Bode  plots  of  H(s)  and  GH(s)  are  shown 
as  H  and  GH,  respectively,  in  Fig. 5.  It  can  be  seen  from  the  plots,  GH(s) 
has  a  gain  margin  of  20db  and  phase  margin  of  50  degrees,  hence  the  system 
should  give  satisfactory  performance  for  the  particular  compensation  H(s) . 

Fig. 6(a)  shows  the  step  input  response  of the  actual  system.  In  order  to 
determine  how  accurate  the  model  is,  the  model  is  simulated  on  a  computer, 
and  the  simulation  result  for  the  same  step  input  is  shown  in  FIG.  6(b). 

From  the  curves,  it  can  be  seen  that  the  compensation  designed  above  indeed 
gives  a  satisfactory  response  and  the  mathematicl  model  is  also  satisfactory. 
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Fig. 5  Bode  plots  of  G ,  H  and  GH. 
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(a)  Actual  system  (5  div./sec.) 


(b)  Computer  simulation  (5  div./sec.) 


Fig.  6  Step  input  response  of  delayed  feedback  system. 
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5.  DISTURBANCE  COMPENSATION  SCHEME 


One  of  Che  problems  encountered  by  a  position  control  system  on  a  moving 
platform  is  the  error  due  to  the  disturbance  caused  by  the  movement  of  the 
platform. In  this  section*  a  compensation  method  for  reducing  the  effects 
of  the  disturbance  in  a  d.c.  motor  driven  third  order  position  control 
system  is  Investigated.  Figure  1  below  shows  the  system  under  study.  The 
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block  diagram  model  of  the  system  is  as  shown  in  Figure  2.  As  can  be 
seen  from  the  block  diagram,  there  Is  a  substantial  nonlinear  Coulomb 
friction  between  the  stator  and  rotor  of  the  d.c.  motor.  When  a  typical 
second  order  position  control,  that  Is,  without  the  additional  integrator 
In  Figure  1,  is  employed,  there  is  a  large  steady  state  error  due  to  the 
nonlinear  friction.  The  additional  integrator  is  therefore  inserted  in 
the  system  to  force  the  steady  state  error  to  be  zero.  Another  reason 
for  the  inclusion  of  the  integrator  is  to  investigate  the  effectiveness 
of  the  proposed  disturbance  compensation  scheme  in  a  third  order  system. 

To  simulate  the  disturbance  due  to  the  motion  of  a  platorm,  the 
stator,  that  is,  the  outer  shell,  of  the  motor  is  rotated,  and  the 
effects  of  the  stator  motion  on  the  position  error  of  the  system  is 
studied.  The  disturbance  motion  of  the  platform,  and  therefore,  the 
motion  of  the  motor  stator,  is  denoted  by  0^,  and  the  system  position, 
that  is,  the  position  of  the  motor  rotor  is  denoted  by  6.  The  system 
error  is  defined  by 
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where  0 is  che  desired  position  angle.  The  disturbance  stator  motion 
0^  affects  the  rotor  position  0  in  three  maior  ways.  The  first  is,  of 
course,  the  disturbance  torque  being  applied  to  the  rotor  shaft  through 
the  frictions  between  the  stator  and  rotor  of  the  motor.  The  second  is 
the  additional  velocity  feedback  due  to  the  disturbances.  The  last  is 
the  electromagnetic  interaction  between  the  stator  and  rotor  motions  of 
the  motor. 

Since  the  velocity  of  the  disturbance  signal,  0^,  is  practically  the 
most  convenient  variable  to  measure,  the  disturbance  compensation  is 
based  on  the  disturbance  velocity  9^.  The  actual  structure  of  the  com¬ 
pensation  scheme  is  shown  by  the  dotted  line  in  Figure  2.  The  values  of 
the  constants  a  and  b  are  determined  experimentally  and  the  actual  values 
used  in  the  current  experiment  are  a  -  0.15  and  b  =  0.001. 

The  step  input  response  of  the  system  without  external  disturbances 
la  as  shown  in  Figure  3.  The  settling  time  is  about  0.8  sec.  in  one 
direction  and  2.6  sec.  in  the  other  direction.  The  difference  in  settling 
time  in  the  positive  and  negative  directions  is  due  to  unsymmetrical 
nonlinear  frictions. 
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To  study  the  effects  of  the  disturbances,  three  different  types  of 
disturbance  motions  are  applied  to  the  stator  of  the  motor,  and  the 
rotor  position  error  is  observed  while  keeping  the  reference  input  0  ^ 

at  zero  degree.  When  no  disturbance  compensation  scheme  is  employed  the 
resulting  system  position  errors  are  as  shown  in  Figure  4.  The  curves  (a) 
represent  the  stator  position  due  to  disturbances  and  the  curves  (b)  rep¬ 
resent  the  actual  system  position  error  due  to  the  disturbances.  When  an 
impulse  of  18“  disturbance  is  applied  to  the  stator,  the  resulting  maxi¬ 
mum  system  error  is  19 “.  For  a  35°  step  disturbance,  the  maximum  error 
is  25*,  and  for  a  33“  peak-to-peak  sinusoidal  disturbance,  the  peak-to- 
peak  error  is  45“  When  the  disturbance  compensation  is  employed,  the 
position  errors  due  to  the  same  disturbances  are  as  shown  in  Figure  5. 

Now  the  maximum  error  due  to  an  18“  impulse  disturbance  is  6°,  the  maxi¬ 
mum  error  due  to  a  35“  step  disturbance  is  9“  and  the  peak-to-peak  value 
of  the  error  due  to  35"  p-p  sinusoidal  disturbance  is  14".  The  results 
are  summerized  in  Table  1.  In  general,  the  disturbance  compensation 
scheme  reduces  the  effects  of  external  disturbances  significantly,  in 
the  present  case,  by  a  factor  of  3. 


(b)  Disturbance  input  (6^) 


Pig.  4  Position  error  due  to  disturbance  in  the  system 
wlehout  compensation  (0.9*/div.,  5  div./sec.) 
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(b)  Disturbance  input  (6^) 


Pig.  5  Position  error  due  to  disturbance  in  the  system 
with  compensation  (0.9°/div. ,  5  div./sec.) 


18*  Impulse 


35*  Step 


33*  p-p  2Rz. 


19* 


25* 


45*  p-p 


14*  p-p 


Table  1.  Position  error  due  to  external  disturbances 
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In  conclusion,  it  is  shown  that  a  disturbance  compensation  scheme  may 
be  employed  to  reduce  the  effects  of  external  disturbances  in  a  position 
control  system.  Since  the  major  portion  of  the  disturbance  is  transmitted 
to  the  control  system  through  the  nonlinear  friction,  a  nonlinear  distur¬ 
bance  compensation  scheme  would  be  more  effective.  Further  research  is 
currently  being  carried  out  to  more  fully  develop  the  disturbance  compen¬ 
sation  methods. 
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6.  DISTURBANCE  CANCELLING  FOR  XM-97  TURRET  USING  TIME  DELAYS 


In  this  sec'.ion,  a  disturbance  cancelling  controller  is  studied  for  the 
XM-97  turret  control  system  using  time  delays.  Since  the  velocity  of  the 
disturbance  is  available  for  measurement  through  a  hull  gyro,  the 
controller  uses  the  rate  gyro  output.  The  block  diagram  of  the  system 
with  disturbance  is  given  in  Fig.  1.  Let  d(t)  be  the  disturbance  hull 
velocity.  Then  the  disturbance  cancelling  scheme  is  basically  that  of 
feeding  back  the  cancelling  variable  z(t)  to  the  input. 


Fig.l  Disturbance  Cancelling  Control 


The  variable  z(t)  is  given  as 

z(t)  -  "  555  (0.04256d(t)  +  0.04d(t  -  0.05)  +  y(t)J 

y(t)  +  10y(t)  -  0.824<d<t)  -  d(t  -  0.05)) 
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Note  that  this  scheme  once  again  uses  a  time  delayed  variable.  When  d(t)« 
1000  Cos(lOt)  and  a  step  reference  input  of  one  degree  is  applied  to  the 
system  without  the  disturbance  cancelling,  the  output  6(t)  is  as  shown 
in  Fig.  2(a).  The  same  response,  but  with  the  disturbance  cancelling, 
is  given  in  Fig.  2(a).  As  can  be  seen,  there  is  a  substantial  improve¬ 
ment  when  disturbance  cancelling  is  employed.  The  disturbance  cancelling 
scheme  is  more  effective  if  an  optimal  control  is  employed.  To  show  this, 
the  scheme  is  now  applied  to  the  optimal  XM-97  turret  system  as  shown  in 
Fig.  3.  The  response  to  the  same  disturbance  is  given  in  Fig. 4.  It  is 
believed  that  at  least  a  part  of  the  further  improvement  is  due  to  the 
elimination  of  the  original  tachometer  feedback  dynamics  as  well  as  the 
application  of  an  optimal  control. 
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7 


MICROPROCESSOR-BASED  OPTIMAL  DISTURBANCE  ACCOMODATING  CONTROL  FOR 
XM-97  TURRET  CONTROL  SYSTEM 


7.1  INTRODUCTION 

The  design  of  a  microcomputer-based  optimal  disturbance  accomodating 
controller  for  the  XM-97  turret  control  system  is  carried  out.  Simulation 
studies  of  the  system  are  made  to  compare  the  performance  of  the  system 
under  different  control  schemes.  Responses  of  the  system  subject  to  firing 
burst  torque  disturbance  as  well  as  sinusoidal  torque  disturbance  are  given. 
Significant  improvemnets  in  the  behaviour  of  the  system  under  disturbances 
are  obtained  using  the  proposed  schemes. 

The  optimal  analog  control  of  the  system  and  system  disturbance  modelling 
are  briefly  dealt  with  in  section  7.2.  The  discrete  version  of  the  controller 
and  the  discrete  disturbance-isolated  observer  are  covered  in  section  7.3. 
Simulation  results  are  shown  in  section  7.4. 
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.1  | OPTIMAL  CONTROLLER  AND  SYSTEM-DISTURBANCE  MODEL. 

The  block  diagram  for  the  open-loop  XM-97  turret  with  disturbance  input  w(t) 
is  given  in  Pig.  1  and  the  corresponding  equations  of  motion  are  given  by 


x(t)  -  Ax(t)  +  Bu(t)  +Fvr  +  Dv(t),  (la) 

*<t)-Cx<t),  (lb) 

where  x(t)  -  [x^t)  x2(t)]T,  x^t)  -  [xr(t)  -  x^(t)],  x2(t)  -  (Nvr  -  x’(t)], 
i(t)  ■  fy^(t)  y2(t)]T  is  the  observed  vector,  w(t)  is  the  disturbance  torque, 
and  A,  6,  D  arid  C  are  given  by 


0  a. 


0  1/N 


0  -1.28  0  -a 


.  B  - 


-2.675x10' 


1.28N 


-10/3N 


1  0 


0  1 


The  control  objective  is  to  drive  Jt(t)  to  the  zero  state  in  the  presence  of 
the  dlatrubance  torque  w(t),  and  in  the  same  time  minimizing  a  quadratic 
performance  measure.  To  achieve  the  control  objective,  the  control  u(t)  is 
split  Into  three  parts  as 

u(t)  -  u£b(t)  +  uff(t)  +^uw(t),  (2) 

where  u£b(t)  is  the  feedback  component  responsible  for  driving  _x C t >  to  the 
zero  state,  u££(t)  is  the  feedforward  component  responsible  for  accommodating 
the  velocity  command  v^,  and  uw(t)  is  the  feedforward  component  responsible 
for  accommodating  the  distrubance  torque  v(t).  It  can  easily  be  shown  that  uf£(t) 
and  u (t)  are  given  by,  respectively, 


«w(t> 


v  ft  k.v 

2.675xl05  r  r  r 


10 


311x2.675x10 


.  w(t)  =  -k  v(t) 
3  w 


Substituting  Eqs.  (2),  (3),  (  4  1  in  to  Eq.  (1)  yields 

x(t)  -  Ax(t)  +  Bufb(t)  . 

Consider  the  performance  measure 

J  -  /  lq1:1x£(t)  +  ru^b(t)]dt, 

o 

where  q^^O  and  r>0  are  weighting  constants. 

The  optimal  control  which  minimizes  J  is  given  by 


(3) 


(4) 


(5) 


(6) 


■  “opt*'’  j 

I 

■  kjXj^t)  +  k2x2(t)  (7)  r 

■  -  x'(t)]  +  k2^Nvr  “  X2^C^‘ 

The  numerical  values  of  the  optimal  gains  k^  and  k2  for  different  values  of 
^11  to8etker  with  the  values  of  feedforward  gains  kf  and  k^  are  given  in  Table  1. 

From  Eqs.  (2),  (3)f  (4)  and  (7),  the  complete  control  u(t)  is  given  by 
u(t)  -  kjX^t)  +  k2x2(t)  +  krvrCc)  “  kww(t)  • 

Since  the  dlstrubance  w(t)  is  not  known,  the  control  u(t)  can  be  implemented  as 

u(t)  -  kjX^(t)  +  k2x2(t)  +  kyvr  -  kvw(t)  ,  (9) 

M 

where  w(t)  is  an  estimate  of  w(t). 

»  _t 
The  estimate  w(t)  of  w(t)  considered  in  this  report  will  be  generated  by  a 

discrete  Luenberger  observer.  For  simplicity,  the  distrubance  w(t)  will  be 
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approximated  by  a  random  step  plus  ramp  function  described  by 


w(t)  -  o(t),  w(0)  -  wq, 


(10) 


vhere  o(t)  is  an  unknown  sequence  of'  pulses  included  to  take  into  account 
of  the  random  change  in  values  of  w(t). 

Augmenting  Eq.  (10)  to  Eq.  (1)  yields 


- 

*  1  * 

-  — 

—  - 

“  — 

—  "" 

*(t) 

as 

A  S  D 

f 

1 

1 

x(t) 

+ 

B 

u(t)  + 

E 

v  + 
r 

0 

w(t) 

o ;  o 

w(t) 

0 

0 

1 

o(t) 


=  Ax(t)  +  Bu(t)  +  Ev^(t)  +  Do(t)  , 
-  Ax(t)  +  Bu’(t)  +  Do(t) 


i(t)  -  [l2j  0] 


x(t) 


w(t) 


3  Hx(t)  , 


vhere  the  various  vectors  and  matrices  are  as  defined,  and 


(Ha) 

(lib) 

(11c) 


u'(t)  =  kj,x1(t)  +  k2x2(t)  -  kw»(t)  . 


Since  the  matrix  pair  [A,  H]  is  completely  observable,  i.e.. 


rank  (HT  J  A  HT  k£T  HT] 


*  rank 


1 

0 

» 

t 

0 

0 

0 

1 

• 

f 

» 

• 

t 

1/N 

-1.28 

;2tht 

0 

0 

« 

t 

t 

0 

-104/3N 

3  , 


(lid) 


the  unknown  disturbance  v(t)  can  be  estimated  by  a  reduced-order  Luenberger 
observer. 
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7.3  DISCRETE  OPTIMAL  CONTROLLER  WITH  DISTURBANCE-ISOLATED  OBSERVER 

In  this  section,  a  microcomputer  based  controller  with  disturbance 
compensation  will  be  designed.  In  this  scheme,  the  disturbance  w(t)  will  be 
estimated  as  w(k)  by  a  discrete  disturbance-isolated  observer  and  the  optimal 
control  input  will  be  realized  as  (see  Eq.  (lid)) 
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For  the  sampling  interval  x  of  10  msec,  the  numerical  values  of  Ad,  Bd  and 
% 

are  given  by 


1  1.6026xl0~5  -4.3175xl0~7 

-2. 1482x1 0-2 

id- 

0  0.98728  -5.3420xl0-2 

•  Bd" 

-2.6580xl03 

0  0  1 

0 

-1.4232xl0~9 
-2.6769xl0“4  • 

.01 


(14) 


The  sampled  measurements  at  t  ■  kx  ate 

Z(k) *(k)  -  r  i2  o  jrx(k)i  -  cd  £(k> .  (is) 

[v(k)J 

A  discrete  disturbance-isolated  observer  which  generates  w(k) 

Is  given  by 


i(W-l)  -  F  x(k)  +  G  jr(k)  +  M  u(k) , 
w(k)  -  *(k)  +  L  ^(k)  , 

where  s(k)  is  a  scalar  and 


F  -  1  -  L  Dd  , 

G  -  Ft  +  An  -  LAn  , 

M  -  Bj  -  LBX  . 

with  the  choice  of  L  given  by 

1  -  T'858arl6d  +  V(I2  -  !8d8drl8d  >  - 

where  V  is  chosen  such  that  F  is  stable. 


(16a) 

(16b) 
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•  Q 


7.4 


atimal  Disturbance  Accommodation  Controller 


With  a  choice  of  t  ^-.01  sec  and  V  •  {7x10  01, and  using  (14), 


the  observer  (16)  is  given  by 


0.038512  z(k-l)  +  [-6.7304x10®  -41,4301^(^1) 

-4.7839x10*  u’(k-l)  , 


(17a) 


z(k)  +  [7x10®  -74.573]£(k), 


(17b) 


while  the  microcomputer  control  Is  given  by 


u(k)  -  kjX^(k)  +  kjX^k)  -  kw  w(k) 


-  2.2361x1(k)  +  1.5949*10"4  x2(k)  -  2.0098*10-5  w(k) ,  (18) 


where  the  first  column  entry  of  Table  1  has  been  used. 
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7.5  OPTIMAL  DISTURBANCE  ACCOMMODATING  CONTROLLER  WITH  DISTURBANCE  PREDICTION 

.It  Is  suggested  that  an  alternative  microcomputer  scheme  to  (18)  can 

be  realized  as 


u(k)  -  V1z1(k)  +  ^ (k)  -  kww(k)  -  kpfU+e)  «(k)  -  ei<k)] 
'*  2.2361  x^(k)  +  1.5949*10-4  x2(k)  -  2.0098*10-5  v(k) 


-o.505i*io“6  iu+e)  C(k)  -  e£(k>). 


(19) 


i  where  the  iast  term  In  the  control  equation  is  a  prediction  scheme.  In  the 

:i  . 

simulation  that  follows.  It  Is  found  that  8-20  yields  improvements  in 
•  the  accommodation  of  the  disturbance. 


(5 


•> 
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7.6  SttftTLATIOK  RESULTS 


Simulation  of  the  performance  of  the  optimal  turret  control  system, 
subject  to  different  disturbance  torque,  under  3  types  of  controls  were 
studied.  These  controls  are 

A.  Without  disturbance  compensation  (kw»0) 
u*(k)  ■  kjX^(k)  +  k^XjOc) 

B.  With  disturbance  oempensation 
u*(t)  »  kjX^(k)  +  k2x2(k)  -  kw  w(k) 

C.  With  disturbance  compensation  and  prediction 

u*(t)  -  kjX^k)  +  kjX^k).  -  kw  w(k)  -  kp  1(1+8)  w(k)  -  Qw(k-l)] 

J 

where  k^t  k^,  kw#  kp  and  8  are  as  defined  In  the  previous  section. 

The  system  was  subjected  to  the  following  external  torque  w(t)  : 

a.  torque  due  to  firing  bursts,  and 

b.  slnosoldal  torque  at  }  Ha,  5  H*  and  10  Rz. 

Pigs.  2(A),  2(B)  and  2(C)  shows  responses  of  -x^(t)  under  the  controls 
A,  B  and  C  respectively,  when  the  system  Is  subject  to  external  torque 
v(t)  due  to  firing /bursts.  The  external  torque  w(t)  and  its  discrete 
estimates  w(k)  obtained  from  observer  (17)  (where  control  B  is  used)  are 
Shown  In  Pig.  3.  A  typical  microcomputer  control  Input  Is  shown  In  Fig.  4 
while  Pig.  5  shows  a  typical  response  of  Xj(t). 

It  la  seen  that  an  improvement  of  about  5  :  1  in  the  reduction  of  ' 
the  maximum  amplitude  of  x^(t)  is  obtained  when  control  B  Is  used  as 
compared  with  control  A.  A  further  Improvement  of  about  10  :  1  Is  obtained 
when  control  C  Is  used  instead  of  control  A. 
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Pig.  6(A),  6(B)  and  6(C)  similarly  depict  the  response  of  x1(t)  under 
control  A,  B  and  C  respectively,  when  the  system  is  subject  to  a  1  Hz 
slnosoldal  external  disturbance.  In  Fig.  7  and  Fig.  8,  the  system  is 
subject  to  a  5  Hz  and  10  Hz  sinosoidal  external  disturbance  respectively. 

In  all  cases,  it  is  found  that  control  B  and  C  suppress  the  tranmission 
of  the  external  disturbance  w(t)  to  the  output  x^(t)  by  an  appreciable 
amount.  Control  C,  which  has  an  element  of  prediction  in  its  algorithm, 
exhibits  a  better  disturbance  suppression  characteristic  over  the  straight 
disturbance  accommodating  control  B. 
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Flg.l  SIMPLIFIED  OPEN-LOOP  XM-97  HELICOPTER  TURRET  CONTROL  SYSTEM 
WITH  DISTURBANCE  INPUT  (TWO-STATE-VARIABLE  MODEL) 


-* 
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Fig, 2(B)  System  subject  to  Firing  Burst  Torque  ,  when  control  B  Is  used. 


Pig. 2(C)  System  subject  to  Firing  Burst  Torque  ,  when  Control  C  Is  used 


Typical  Microcomputer  Control  Input  (  Control  B  shown 


***•  6(b)  System -subject  to  1  Hz  Slnosoldal  Disturbance  ,  when  Control  B 
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Sinosoldal  Disturbance  ,  when  Control  A  is  used 


ea  subject  to  S  Hz  Slnosoldal  Disturbance  ,  when  Control  B  Is  used 
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Pig.  7(C)  Systea  subject  to  5  Hs  Slnosoidal  Disturbance  .  when  Control  C  is  used. 


Pig.  8(A) 


subject  to  10  H*  Sinosoidal  Disturbance  ,  when  Control  B  Is  used 


8.  MICROPROCESSOR-BASED  COMPENSATION  FOR  NONLINEAR  FRICTION 


One  of  the  problems  which  occur  frequently  in  a  mechanical  position 
control  system  is  the  non-zero  steady  state  error  due  to  nonlinear 
frictions  such  as  Coulomb  friction  and  stiction.  The  steady  state  error 
may  be  reduced  by  increasing  the  gain  or  by  gearing  down  the  motor  output. 

It  may  also  be  reduced  by  using  the  integral  of  the  error  as  the  control 
input.  However ,  these  schemes  may  also  introduce  instability,  excessive 
overshoot  and  long  settling  time.  In  this  Chapter,  we  investigate  another  mentW-d 
which  is  based  on  a  microprocessor  to  reduce  the  steady  state  error. 

The  system  investigated  was  a  d.c.  motor  driven  position  control 
system  shown  in  Fig.  1. 


Fig.  1  DC  MOTOR  POSITION  CONTROL  SYSTEM 


In  addition  to  the  Coulomb  friction,  the  system  contained  some  striction 
-  as  well.  However,  the  compensation  scheme  was  mainly  for  countering  the 
Coulomb  friction.  The  mathematical  model  of  the  system  is  given  in  Fig.  2. 


Fig.  2  MATHEMATICAL  MODEL 


When  a  step  input  of  IV  was  applied,  the  response  was  as  shown  in  Fig.  3. 
As  can  be  seen,  the  steady  state  error  was  approximately  0.2  *  0.3V 
(20  •«*  30Z).  The  variation  of  the  error  was  due  to  non-uniform  frictions. 
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To  reduce  the  error,  a  microprocessor  based  compensation  scheme  was 
4  Implemented  as  shown  in  Fig.  4. 


Fig.  4  SYSTEM  WITH  FRICTION  COMPENSATION 


The  error  and  the  velocity  of  the  motor  were  sent  to  the  microprocessor 

through  A/D  converters,  and  the  compensation  command  E  was  sent  to  the 

,  comp 

system  input  through  a  D/A  converter.  Basically,  the  compensation  signal 
was  determined  by  the  following  equation. 
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>  O.lV/sec. 

<  0.008V 

<  O.lV/sec.,  e  >  0.008V 

<  O.lV/sec.,  e  <  -0.008V 


When  the  same  step  input  of  IV  was  applied  to  the  compensated  system,  the 
response  was  as  shown  in  Fig.  5.  The  actual  steady  state  error  was  less 
than  0.001V. 
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V0 (volts) 


Fig.  5  STEP  RESPONSE  OF  THE  COMPENSATED  SYSTEM 


